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Abstract 


The need of the multifingered mechanical hands as dexterous end- 
effectors for robotic devices has been widely felt due to their capability 
and versatility. In the present work basic theory for multifingered hands 
is presented. The position and orientation of the fingertips and the object 
with reference to the base of the hand is calculated as a function of Joint ’ 
variables using forward kinematics. Controller scheme is presented for 
tracking a specified trajectory of a grasped object. Dynamic equations of 
motion are used to develop a mathematical model for the controller, j 
Grasping force control issue is also considered covering the issues of the | 
contact point stability criterion and grasp stability. Concept of j 
coefficient of friction angle is also introduced to compare actual grasp 
with ideal stable grasp. Finger links and base plate are designed The 
criteria for selection of motor/power drive is also discussed. Strain 
gauges are used to measure the transverse force applied at the fingertip. 
Scheme for the required electronic circuitry is also presented. Object 
grasp is accomplished under static conditions. 



Contents 


Acknowledgments 
Abstract 
List of Figures 
List of Tables 

1 Introduction 

1.1 Introduction 

1.2 Literature Review 

1.3 Objective and Scope of the Present Work 

2 Multifingered Planar Hand Kinematics 

2.1 Introduction 

2.2 Forward Kinematics 

2.2.1 Basic Relations 

2.2.2 Constraints 

2.2.3 Finger Kinematics 

2.2.4 Finger-Object System Kinematics 

2.2.5 Grip Transformation Matrix 

2.3 Static Force Equations 

2.3.1 Static Force at Contact Points 

2.3.2 Static Force at Origin of Object Frame 



3 Control Scheme 19 

3.1 Introduction 19 

3.2 Equations of Motion 20 

3.3 Controller Model 22 

3.3.1 State Feedback Controller 26 

3.4 Control of Grasping Force 28 

3.4.1 Optimal Grasping Strategy 29 

3.4.2 Grasping Force Considerations 31 

4 Design Details 33 

4.1 Introduction 33 

4.2 Finger Design 34 

4.3 Motor Selection and Specifications 42 

4.4 Force Sensing using Strain Gauges 45 

5 Implementation, Results and Discussions 50 

5.1 Strain Gauge Calibration 50 

5.2 Amplification of Bridge Output 52 

5.3 The Controller Board 54 

5.4 Feedback Board 60 

5.5 Results and Discussions 61 


Bibliography 


68 


List of Figures 


2.1 Planar non-redundant 3 -fingered hand grasp constraints 6 

2.2 Planar hand and object schematic 7 

2.3 i*** Finger schematic in World Coordinate Frame 8 

2.4 Finger arrangement schematic 8 

2.5 Object frames schematic 11 

2.6 Velocity of the 1“" contact point 15 

2.7 i*** contact point schematic 16 

3.1 Representation of a translated object frame 21 

3.2 Defining the grasping force parameter 23 

3.3 Block diagram for the closed-loop control 27 

3.4 Schematic representation for a typical contact case 29 

4.1 Planar hand joint axes schematic 34 

4.2 Object position and orientation schematic 35 

4.3 Finger links arrangement schematic 36 

4.4 Link assembly schematic 36 

4.5 Provision for clamping of shaft 37 

4.6 Strain gauge mounting schematic 37 

4.7 Link-1 dimensions 38 

4.8 Link-2 dimensions ^38 

4 9 Fingertip covering schematic 39 

4.10 Overall finger arrangement 

4.1 1 Base plate dimensions ^ 4^ 

4.12 Object dimensions 40 

4 . 13 Top view of the actual setup 41 

4.14 Motor operating range ^ ^^^^^^ ^^^^^^^^ 44 



4.15 Dimensions for the selected motor 45 

4.16 Resolving the components of the contact force 46 

4.17 Wheatstone bridge arrangement for measurement of 46 

4.18 Wheatstone bridge arrangement for measurement of 47 

4.19 PCB diagram for measurement of (i^)^ 48 

4.20 Force feedback schematic 49 

5.1 Graphical representation of calibration results 52 

5.2 Output voltage amplification schematic 52 

5.3 Pulse width modulation with square wave form 55 

5.4 Schematic for combined pulse width modulation 55 

5.5 Block diagram for L-298 dual full bridge driver 56 

5.6 PCB diagram for the controller board 58 

5.7 PCB diagram for the feedback board 59 

5.8 Nomenclature convention for motors and fingers 60 



List of Tables 


4.1 

Basic features of the motor used 

42 

4.2 

Important motor specifications 

43-44 

4.3 

Strain gauge specifications 

49 

5.1 

Calibration chart for strain gauges 

51 

5.2 

Signals for different motor motions 

57 

5.3 

Output voltage observations 

61 

5.4 

Conversion chart 

62 

5.5 

rms. Voltage observations 

62 

5.6 

Current and torque calculations 

63 

5.7 

Measured joint angles 

63 

5.8 

Transverse components for the three-fingers 

66 



Chapter 1 


Introduction 


1.1 Introduction 

The need of multifingered mechanical hands as dexterous end-effectors 
for robotic devices has been widely felt. Such capabilities of these devices 
range from securely grasping a broad range of objects to performing fine 
manipulation tasks. Apart from dexterity, multifingered hands are also 
versatile devices which can serve various purposes ranging from a simple 
manipulation to complicated assembly operations. Grasping of an object by a 
computer-controlled hand is an important task because it precedes any other 
movement of the object by the hand. Also it is the point at which uncertainty 
in the position and orientation of an object is first encountered. The purpose 
of this work is to develop an understanding of the theory of manipulation and 
using it for the development of a three-fingered planer hand. 



1.2 Literature Review 


Probably the first occurrence of mechanical hands was in prosthetic 
devices to replace lost limbs. Almost without exception prosthetic hands have 
been designed to simply grip objects. Other related field in which artificial 
hands have found use is in remote manipulation. The need to work with 
hazardous materials or environments has spawned the development of master- 
slave or teleoperated systems. These devices permit the user to perform simple 
manipulations from a safe remote location by employing mechanical arms 
directly controlled by the operator through electrical or mechanical means. 

Significant hand design attempts were made by Okada[Okada, 1979] 
and Salisbury[Salisbury, 1989], Cutkosky[Cutkosky, 1985] developed a 
procedure for analyzing the grasp properties of stiffness and resistance to 
slipping, in order to compare grasps. Kerr and Roth[Kerr, 1986] formulated 
the linearized constraint concerning the fingertip forces due to the fingertip 
contact and proposed an optimal selection of the fingertip force in a static 
grasp using linear programming. The problem of stable grasp in a plane is 
discussed in [Nguyen, 1986]. Kobayashi[Kobayashi, 1986] discussed the 
control and geometric aspects for an articulated robot hand. Fearing[F earing, 
1986] and Omata[Omata, 1994] discussed a new force strategy for object 
reorientation. Kumar and Waldron [Kumar, 1989] proposed a sub-optimal 
method for grasping force computation, based on the superposition of finger- 
interaction forces on force equilibrium. Cole, Hsu and Sastry[Cole, 1992] 
considered the problem of dynamic control of a multifingered hand 
manipulating an object under the condition that some of the fingertips slide on 
the object surfaces. Schemes and algorithms for finding the optimal fingertip 
forces were offered by Nahon and Angeles[Nahon, 1992], Mukerjee and 
Waldron [Mukerjee, 19 92], Guo and Gruver[Guo, 1993] and Shimoga[Shimoga, 
1996]. The control strategies were offered by Chung and Waldron [Chung, 
1995]. Kvrgic[Kvrgic, 1996] proposed a new method for computing the 
grasping forces of the object grasped by multiple cooperating manipulators or 
a multifingered robot hand. The iterative algorithm for predieting grasping 
force and moment components, satisfying their limitations and condition of 
the minimal internal loading, was proposed. Mackawa, Tanic and 



J 


Komoriya[Mackawa, 1996] proposed dynamic grasping force control for a 
multifingered hand and experimentally confirmed the validity of the proposed 
method using a two-fingered hand with finger-shaped tactile sensors. 


1.3 Objective and Scope of the 
Present Work 


This work attempts to solve the problem of development of a three- 
fingered planer hand. Initially positions of the fingertips and the object in the 
base frame is found out. Using static force equations, contact force and the 
force at the origin of the object frame is found. The controller is modeled and 
the mechanical parts are designed. Strain gauges are used for the force 
feedback for the transverse force. Scope of present work is to provide real- 
time closed-loop trajectory control. 

This thesis has been organized into five chapters. In chapter 2 the 
problem of multifingered hand kinematics is introduced. Forward kinematics 
solution for the finger-object system is presented. Equations for computing 
static force at fingertip-object contact points and at the origin of the object 
frame are presented. In chapter 3 dynamic equations of motion are discussed 
in brief. A controller model is presented and grasping force is discussed. In 
chapter 4 design details are given. Various parts of the finger are discussed. 
Motor selection criterion is also given. Force sensing scheme for strain gages 
is also presented. In chapter 5 the strain gauge calibration data is given. 
Amplification scheme for the Wheatstone bridge output is discussed. The 
controller board and feedback board are discussed. Finally the results and 
discussions are presented. 
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Chapter 2 

Multifingered Planer Hand 
Kinematics 


2.1 Introduction 

Finger kinematics deals with the study of the mapping of joint 
coordinates to fingertip coordinates in motion, and the inverse mapping of 
fingertip coordinates to joint coordinates in motion. To study the geometrical 
and time based properties of the manipulator motion, analysis of the hand 
kinematics is presented. In this chapter, position and orientation of the finger | 
links in static situations are considered. In order to deal with the geometry of 
a finger, frames are attached to various parts of the links and then the : 
relationship between these frames is described. Hand kinematics also involves 
the change of location of these frames as the links articulate. The central topic 
of the present chapter is basic theory and method to compute the position and : 
orientation of the fingertips and the object relative to the base of the hand as a i 
function of joint variables. 
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2.2 Forward Kinematics 

For manipulation of an object in a required manner, knowledge of 
object position and orientation is essential at all instants of time. If the fingers 
do not leave contact with the object and if the fingers do not slip over the 
object surface, the position and orientation of the object can be determined 
with the help of forward kinematics relations from the measurement of joint 
angles of the finger joints. Forward kinematics is the static geometrical 
problem of computing the position and orientation of fingertips and object 
relative to the base frame. 

2.2.1 Basic Relations 

Let us consider a multifingered planer hand consisting of fingers, 
each finger having degrees of freedom. Task space dimension = 2 and 
the object degree of freedom = 3. \ 

To define position and orientation of a body in a plane, specifications S 
of coordinates of two points on a body are required; thus at least two fingers j 
are necessary to grasp an object in a planer hand[Montana, 1995], Hence for a 
planer hand case N^. > 2. It is sufficient to have non-redundant fingers i 

N^], because each finger only positions the contact point on the object at a 
particular point of space in the task space. Therefore, in the planer hand, 
number of links in each finger is taken as two. ; 

I 

' ■ i 

2.2.2 Constraints 

In order to maintain contact with the object surface, fingers have to 
follow some constraints. The total number of constraints iV^, to be satisfied by 
non-redundant fingers [N^ = = 2] in order to maintain the contact with the 

object having degrees of freedom iVp = i, are such that ) = | 

(2N-3). ' " I 

For the present analysis Coulomb Friction Model is considered for the 
contact between the object and fingertips. As in [Mason, 1986], the fingers are 
assumed to grasp the object at their tips. This ensures a point contact and a 



fingertip grasp which is essential for dexterous manipulation as discussed in 
[Cutkosky, 1989], The object is assumed to be a rigid body. As the object is 
rigid, the distance between any two finger contact points is constant and it 
serves as a constraint for proper contact as shown in Fig.(2.1) for A^= 3. C is 
the contact point for the fingertip, where i = 1,2,3. 



Figure 2.1 : Planer Non-redundant 3-Fingered Hand Grasp Constraints 

The constraints can be represented as > 

I' 

f = 0 (2.1) , 

where is the constraint between the /"’and (i+J/^finger, xVand are 
the position vectors of the corresponding fingertips in the World Coordinate 
Frame and is the distance between the corresponding contact points. 

Since x' and are functions of joint variable vector 0 from forward 
kinematics, is also a function of 0. Thus the constraints can be combined i 
and written as I 


2.2.3 Finger Kinematics 


For the i^’' finger of a multifingered mechanical hand having fingers 
in order to represent the position vector ]C of the fingertip in the World 
Coordinate Frame the forward kinematics relations are defined as 

a function of joint variables 0' 

r = (2.3) 

where AT is the fingertip position vector of the order N^-Kl and 
0' is the finger joint variable vector of the order N^xJ. 



For the selected planer hand with Nf= 3, = 2, the fingertip 

coordinates for the finger ( i -1,2,3 ) can be defined as 

x' = ijcos0;+4cos(0;+0^)+4 (7 4 \ 

y =4sin0;+4sin(0;+0^)+d; 

where 4.4 the length of respectively the first and second link for 
finger, 0 j , 04 is joint angle for the 7* finger and (d” ,^4) is the coordinate of 

the finger base 5’ in the World Coordinate Frame as shown in Figs. (2.2) 
and (2.3). 



o 



Figure 2.3 : i*'' Finger Schematic in World Coordinate Frame 


Thus position vector of the fingertip of arm is written as 



Figure 2.4 : Finger Arrangement Schematic 


Fig. (2. 4) shows the arrangement, of the base 5’ of the i* finger on the 
base plate for Nj.= 3. a' is the angle measured from positive x-axis in the 
World Coordinate Frame at which the base point B’ is situated. 
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Velocity vector : 

The velocity relation for the i'* finger, which relates the joint velocity 
and the fingertip velocity can be obtained by differentiating equation(2.3) with 
respect to time 


X' = v‘ = -^ 0' 

" 50 ' 


( 2 . 6 ) 


or, 



(2.7) 


df 

where is the fingertip velocity vector, Xj- = is the Jacobian Matrix of 

50' 

the finger and 0' is the joint velocity vector. The orders of ,v/} and 0' for 
the selected planer hand are 2x1, 2x2 and 2x1 respectively. 

Finger Jacobian : 

The Jacobian is a multidimensional form of the derivative. Thus for the 
/■‘''finger the Jacobian can be represented as [Duffy, 1996] 


■4 


50' 


( 2 . 8 ) 


where ^ is the function of joint angles and it represents position of the tip of 
the finger. 

For a planer hand, as shown in [Craig, 1986] the Jacobian for /"' finger 
can be written as 


4 


sin0' - 4sin(e'; + 0^) -4sin(0; +0' )' 
|_ /j cosB'i + 4 cos(0| + ©a) 4 cos(05 + 62) 


(2.9) 


The combined Finger Jacobian Matrix can be written as 


J^ = Diag(/} 


r/) 


( 2 . 10 ) 


where N. is the number of fingers. 
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For planer hand Jj- is a 6 x 6 matrix as discussed in [Fu, 1987], 

Rate kinematics : 

Using the velocity vector of the fingertip for the finger 
[equation( 2 . 6 )], the combined fingertip velocity vector can be written as 


0 ^ 

!l 

CD 

(2.11) 

where v, = [(v^)^ (vlf 

is the combined fingertip 

velocity vector and Jy = Diag( Jj 

JfO- 


2.2.4 Finger-Object System Kinematics 


For an object, the origin Oq of the object coordinate system is 
arbitrarily selected at any point in the object and the frame OqXqYqZq is fixed 
to the object. In order to relate the position and orientation of the Object 
Frame with reference to World Frame , a new object 


frame is taken and a transformation matrix is defined for transformation from 
object coordinate system to world coordinate system. 

Three non-collinear contact points are assumed on the object surface 
(Fig. 2.5), which can be represented in World Coordinate Frame as a function 
of joint angles as shown in equation(2.3). 

and JSf^are iVjX 1 position vectors in World Coordinate 
Frame for contact points 0,,02 and O 3 respectively for the selected planer 
hand with iV^ = 3; = 2 is the dimension of the task-space and 0j, 02,03 

represent N^xl finger joint variable vectors, = 2 being the degree of 
freedom for each finger. It is to be noted that three non-collinear contact 
points are sufficient to define the new coordinate frame. 

Let us define two vectors 0,2 and O 32 such that 



^ (X^ -X^) 
X^-X^ 


, and 


( 2 . 12 ) 
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Figure 2.5 : Object Frames Schematic 

As shown in Fig. (2. 5), let us take a new object frame with 

origin at Oj, which could be expressed with the help of unit vectors o^x^, 02^2 > 
©2^2 respectively. 


^2^2 ^12 

^ 2.^2 ~ (^ 12^^32 
^ 2^2 "■ ^ 12^^32 



[unit vector along O2X2I 

(2.14) 

)^Ol2 

[unit vector along 0272] 

(2.15) 


[unit vector along O2Z2] 

(2.16) 



Thus for the planer hand 


[(x’-x")"+(y-/)]^ 


( 2 . 17 ) 


^2^2 = 


[{(x^ -x^xy -// -(x‘ -x^xy -/)(y^ -y)}r+{(x‘ cy -/)-(x' -x^icy -/»;] 

[(x' - x^f +(y -y )^][(x* -x^f + (y -y f ]>^ 

( 2 . 18 ) 


The homogeneous transformation matrix for representation of 

Object Frame O2X2Y2Z2 in the World Coordinate Frame, can be expressed as 


Wt = 


^2^2 ^ 2^2 

0 0 1 


( 2 . 19 ) 


since for the planer case, z-components are taken out. I 

Let a matrix ^2^ is defined, which represents the Object Frame | 
OqXqYqZq in the new frame Matrix % is a constant matrix, since the j 

object is assumed to be rigid and both frames 02X^^2 OqX^YqZq are 
fixed to the object. Thus the matrix \ is a transformation matrix representing i 
frame O^X^^Zq in frame O2X2Y2Z2. \ 

Thus the transformation matrix representing Object Frame j 

OoXoYqZq in the World Frame can be written as ! 



Wrp 2nn 


( 2 . 20 ) 


The constant transformation matrix ^2^ can be computed once and for 
all at the time of grasping assuming that at the time of grasping, the 
representation of object frame in World Coordinate Frame is known, i.e., 
the rotation matrix representing the orientation of object frame in World 
Coordinate Frame and the position vector p^denoting the position of the origin 
of the object frame with respect to the world frame is known at the time of 
initial grasping. 
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Thus at the time of initial grasping 




Po 

1 


( 2 . 21 ) 


The transformation matrix is parametrized by three independent 
parameters; one for orientation in World Coordinate Frame about z-axis 
and two for position of the object frame origin in World Coordinate Frame. 
These parameters physically represent the position and orientation of the 
object in the World Coordinate Frame. 

Thus 


w 


i? =R„ 

o Z 


cosvj/j -sin\(/^ 0 

sin\i/^ cosv|/^ 0 
0 0 1 


( 2 . 22 ) 


where vj/^ is the angle of rotation of object frame OoXqYqZo about the axis { 
OyiXw of the World Coordinate Frame and is the rotation matrix I 

for rotation about z axis. | 

Thus the position and orientation, as discussed in [Nof, 1985] for the ; 
general case, of the Object Frame in the World Frame, can be represented 
vectorially as I 



(2.23) : 


where y is 6x1 vector representing the position and orientation of the object, 
Po-iPo Po Pof is the position vector of object frame origin in World 
Coordinate Frame and \(/o=[v}/^ is orientation vector containing 

roll-pitch-yaw coordinates. 
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For the planer hand, the equation(2.23) reduces to 


y = 



(2.24) 


where Po^,Po^ denote position vector components in x and y direction and 

represents orientation of the object about z-axis in World Coordinate Frame . 

As the position and orientation of object in World Coordinate Frame 
can be denoted as a function of joint angles 0, the generalized position vector 
y can be represented as 


= h„(e) 


where ho(0) is a function of joint angles, such that h^(0) = 



(2.25) 


Rate kinematics : 

For the finger-object system rate kinematics equations can be obtained 
by differentiating equation (2.25) with respect to time as 
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(2.26) 

or. 

II 

(2.27) 


where y is combined linear and angular velocity vector of the object in World 
Coordinate Frame, 0 is combined finger joint velocity vector and J^, is hand 
Jacobian matrix. 

Hand Jacobian for a planer hand is a matrix of order 3x6, which can 
be written as 


1 


15 


(2.28) 


where Po^,Po^ denote position and represents orientation of the object in 
World Coordinate Frame for a planer hand case. 

2.2.5 Grip Transformation Matrix 

Grip Transformation Matrix is the relationship of object and joint 
velocity vectors as discussed in [Yoshikawa, 1990]. Let for an object 
d - (4 dy ddf is the position vector of the contact point in the object 

frame. - 


contact point ■ 



Figure 2.6 ; Velocity of the contact point 

Given the linear and angular velocity vectors respectively, of 

the object frame; the velocity of the f'' contact point as shown in Fig. (2.6) can 
be written as 


v' =A + V<,xc 


(2.29) 
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or, v* = G'j> (2.30) 

where represents the velocity vector of contact point, 

y = (Po VJ,^nd 



Figure 2.7 : F** contact point schematic 

The schematic diagram for representation of contact point in Object 
Frame is shown in Fig.(2.7). 

Combined velocity vector for all contact points can be written as 

v^ = Gy (2.32) 

where v^ = [(v^)^ ... ... , iV^ is the number of fingers, 

G-[0' ... f Grip Transform Matrix and y is [jjJ Vof 

Combining equations(2. 1 1) and (2.32) as discussed in [Cole, 1992] 


(2.33) 



Gy = J fQ 
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The Moore-Penrose Inverse [Rao, 1971] of the Grip Transform Matrix 
G is defined as 

G*^ = G(G^G)-’ (2.34) 

2.3 Static Force Equations 

We consider a situation in which all the joints of a manipulator are 
locked so that it becomes a structure. Then each link in this structure is 
considered and force-moment balance relationship is written in terms of link 
frames. Finally, solution for the set of joint torques needed to support a static 
load acting at the finger tip and to keep the system in static equilibrium is 
calculated. 

2.3.1 Static Force At Contact Points 

The torque vector (x) [torque at the link joints], the finger Jacobian 
matrix {J/), and Cartesian force-moment vector (i^) acting at the fingertips 

are related as [Klafter, 1989] 

t = (2.35) 

For the planer hand case, 

(2.36) 

where t' (/ =7,2, 3) is the torque at the joints of the finger such that 
x' - [x'i 4]^’ ~ Diag( J} J} J}) is the combined finger Jacobian [as 

given in equations(2.9) and (2. 10)], Ff Ff^ is the combined 

force vector for all contact points such that 7^’ = ^7^^ 
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2.3.2 Static Force at Origin of Object Frame 


The Generalized Force Vector acting at the origin of the Object 
Frame , is defined in terms of combined force vector at the 

contact points as [Mason, 1986] 


K = C/F, = 


1 

0 

-ci 


0 

1 


1 

0 


0 

1 


1 

0 


c‘ -c: c; -c,. 


0 

1 


K 

Fj 


K 

F! 

L 


(2.37) 


where is the grip transformation matrix as defined in equation(2.32), 
d =(c^ dyY is the position vector for the contact point ( i = 1,2,3 ) in the 
object frame and F^ is the contact force at the i"’ contact point as defined in 
equation(2.35). 

Also, 



Fo, 


^;r 

II 


= 

Fl+Fl+Fl 


lkJ 


-d/l + - iFi + clFl - cX + cx _ 


where F^ ,Fg are the x and y components of the forces at the origin of the 1 

^ y ( 

Object Frame OoXqYoZo and is the moment about z-axis at 0^. 

We can also write as 

'^ = JlFo = 4G^Fc ^2.3^ 

where is the hand Jacobian matrix [as defined in equations(2.26)-(2.28)]. 
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Chapter 3 

Control Scheme 



3.1 Introduction 


Control is the process of making a variable or system of variables 
confirm to what is desired. In this chapter, control scheme for tracking a 
specified trajectory of a grasped object is discussed. Here, all the equations 
have been developed for a three-fingered planer hand, each finger having two 
degress-of- freedom. Initially mathematical model for the controller is 
presented. Equations of motion are used to develop the model but physically 
no dynamics are involved. Position, orientation, system constraints and 
grasping force parameters, which are taken as input, are converted to new 
input vector 7i = [7t^i using controller equations and overall 

controller is modeled. Also control of grasping force is discussed covering the 
issues of contact point stability criterion and grasp stability. Concept of 
coefficient of friction angle (c.f.a.) is introduced to compare actual grasp with 
ideal stable grasp. 
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3.2 Equations of motion 

The dynamic equation for the complete hand can be derived by 
combining the dynamics of the fingers with the dynamics of object through the 
contact constraints [Cole, 1992]. 

Finger Dynamics : 

The dynamics of the finger can be written in the form 

A^{e’)0'' + Fi = f (3.1) 

where A/’(0') is the positive definite inertia matrix of the finger, fif(0',0') 
represents the centripetal, Coriolis, friction and gravitational terms, J) is the 
Jacobian matrix of the finger, is the fingertip contact force vector, and x' 
represents the joint torque vector. 

For 3 fingers, with only two joints per finger, equation(3.1) may be 
aggregated to give 

A/(0)0+£/(e,©) + ^/‘iV = 'c (3-2) 

where M{Q) = Diag{M\Kf',M^) is the 6x6 combined finger inertia matrix, 
40 , 0 ) = is the 6x1 vector of centripetal, Coriolis, friction and 

[ 1^ T 7 * 1 ^ 

F^ /f F^ I is the 6x1 combined vector of finger 

[ T T 7 

x' x^ x^ is the 6x1 combined joint torque vector. 

Object Dynamics : 

The equations of motion for the object, written about the centre of 
gravity of the object, can be represented as 

Mj^)y +dJ^y,y)=^G'^ F, + F^ 


(3.3) 
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where y = {^Peg^ pcg^ vj/^J is the 3x1 vector with Pcg^,Pcg^ representing the 
position vector in x-y plane and v|/^^ reprsenting the orientation of the 

principal coordinate frame looted at the centre of gravity in the World 
Coordinate Frame, = Diag{mJJ,l) is the 3x3 inertia matrix of the 

object, is the mass of the object, I represents the moment of inertia matrix, 

U is the identity matrix, d^g{y,y) = {^rn^ xC/co)^) is the 3x1 vector, G is 

the Grip Transform matrix, is the 6x1 combined vector of finger contact 
forces, and is the external force acting at the centre of gravity of the 
object. As shown in Fig. (3.1), the position vector p^^ in equation(3.3) can be 

written in terms of position vector p^ of the object frame and a 2x1 consant 
vector r = (r,.,r^) as 

Po = Pcs ^ r (3 . 4 ) 



Figure 3.1 : Representation of a Translated Object Frame. 

Using equation(3.4), equation(3.3) can be written as 


MSy)y*‘ih,y)=G’F,+F^ (3.5) 




22 


From equations(2.25)-(2.26) and (3.3), the object dynamics can be 
represented as 

H(e) ^^ 9 +<(e,e) + = o% + (3.6) 


Finger-Object Dynamics ; 

The fingertip contact force vector can be calculated as 




(3.7) 


where manipulating force represents the particular solution and the 

grasping force represents the homogeneous solution for the contact force 
F^. The particular solution F^ denotes the equilibrating forces, solely 

responsible for balancing the external forces and does not contribute to the 
grasping forces. F^ is an arbitrary vector in the null space of the Moore- 
Penrose inverse G*^ of the grip transformation matrix G^. 

From [Kumar, 1988] the combined finger-object dynamics can be 
written as 


M(&)9+d{B,Q) + r^F,-J}G’’F„ = T 


(3,8) 


where M- 
d = 


A40)+./;G''[M,(e)§] 


and 


d(0,e) + JjG''k(9,e) + A<,(0)^(§9)e] 


3.3 Controller Model 


Let a matrix is defined as 


jy 


(3- 9) 
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such that the null space of is completely spanned by the columns of the 
matrix Nq for a force closed grasp. 

Then, the vector can be expressed as 

Fh = ^gX (3.10) 

where % is an arbitrary vector of dimension 3x1 for the planer hand case. 



Figure 3.2 : Defining the Grasping Force Parameter X;, 

Define a linear transformation matrix L of dimension and rank(I,)=3 
for the planer hand case such that LF^ gives the projection of the difference of 
the contact forces along the line joining the corresponding contact points. 
Projection of the difference of the contact forces and can be written 
from the figure(3,2) as 
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or,\ = [(x^ - xy -(r -x^yj 


F^' 

c 

Fj 


or,\ 


I^F^ 


(3.11) 


where X,^ represents the first grasping force parameter component, X^ and X^ 
are the position of the first and second contact points, respectively, in the 
World Coordinate Frame The grasping force parameter is 

written as 



(3.12) 


The linear transformation matrix L is defined as 



F 


■(x*-x^)* 

(y-/)* -y-xy 

-y-yy 

0 

0 1 

L = 

F 

= 

0 

0 {x^-xy 

y-yy 

-(x^-x^)* -(/-/)* 


je 


-(x'-jc')* 

-{f-yy 0 

0 

(x^-x')* 

y-yy j 


(3.13) 

where (Z* - )* = (Z' - ) / IZ' - I 


Using equations(3.11) and (3.13), the complete grasping force parameter 
vector Z* can be written as 

K^LF, (3.14) 

As discussed in [Dasgupta, 1998], we have 

iF, = 0 (3.15) 

Thus 


\=L(F^+F^) = LF, = Ufa% 


(3.16) 
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Let a vector 2 , 5^5 is defined such that 


where = 


Po, 

A 


z = [zf z[ 4 4 4] (3.17) 

is the generalized position vector denoting the position and 


orientation of object in World Coordinate Frame, Zj = z, = 0 , z. 


( 1)'2 

r 

ct)^’ 


0 is 


the constraints vector, z^ = ij = 0 , and z^ = 'k,^ = LF^. Here L is the linear 
transformation matrix, is the contact force vector and is grasping force 
parameter. Also let us define the derivatives of the vector z such that 


=-^2 

Z3=Z4 

25 = w= if, 


4 = 0 
Z 4 = 0 


(3.18) 


where w is fictitious input as defined in equation (3.25). 


The equation of motion can be written as 


x = d + Jj-NqLXj, + MT ’ 


7t; 

T 

n 


' 2 j 


-MT 


1-1 


ae 

ae 


(¥) 


(3.19) 


wherex is the applied joint torque, d = 


0 

0 

-mg 


is the vector of gravity terms 


[m = mass of the object], Jf is the finger Jacobian ( 6 x 6 ), is the grasping 


force parameter vector, M = 


10 0 
0 1 0 
0 0 1 


is the inertia matrix, F 


ae 

ae 


IS a 


r . ■ iT ' 

square non-singular matrix, tc — '^2 defined in equations(3.21)- 
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(3.23), is the grasping force parameter vector, is the generalized 

position vector from equations(2.24) and (2.25), and (j) represent constraints. 
Here L is defined as following 

L = (LN^r (3.20) 


3.3.1 State Feedback Controller 




Ti/ is expressed in terms of vector 


T „T JT J' 

^2 *^3 *^4 


as following 


71 ] ^ (Zj Zy ) (^2 Z2^ ) 

^2 ~ (^3 ^3d)~~ ^2v (^4 “* ^4d ) 

'^3 ~ ^5d ~ ~'^5d) 


(3.21) 

(X3.22) 

(3.23) 


where subscript-c/ denotes desired reference values, = Diag{K\p K^p ^p), 
K,^ = Diag{Kl Kl Kl), K,p = Diag{K^p K^p K^), 


K^,=Diag(K^^ Kl. isTlJand 


Kj.^Diag(K} K} K}) 


are positive definite gain matrices, and \ is the feedback of the grasping 
force parameter vector. 

The overall controller for the closed loop system can be written as 


x=d + rNaLX^ + Mr 



I-— (r0)0- 


1 

O 

(2, -ZxJ 



o 

1 



1 50^ ’ 

0 




_ 0 




w = m 


' ^5d 


(3.24) 

(3.25) 


The desired trajectory of the object, in terms of the position, velocity and 
acceleration of the object, is specified through Zij,Z 2 ^ (ij^) and (zj^) in 
equation(3.21). For the constraints to be satisfied, the desired values of z^, 
(Zg^) and Z 4 ^ (4,) are specified in equation(3.22). The desired trajectory of the 
grasping force parameter vector is specified through z^ and z^ . 























The feedback of the grasping force parameter vector in 
equation(3.23) is obtained from the measurement of the finger contact force 
F^. From the equation(3.16) \ could be written as 

k = LF, ( 3 - 26 ) 


3.4 Control of Grasping Force 

For a typical contact situation at /''’fingertip, where the contact force 
is applied at the point of contact and C", Ci , respectively, represent the 
component of the contact force along the contact normal and tangential force, 
the condition for stability of the contact at the point of contact can be written 
as 

M,,.||c’||-||q||>o 

where |X, is the coefficient of friction for fingertip-object contact. 

Above relation represents a convex cone, known as friction cone. Grasp 
is stable [Bicchi, 1 995] if, at each contact point, the contact forces are within 
the corresponding friction cone. 

The significance of the equation(3.27) is that the net force at any 
contact point must satisfy this equation. The net force F^ at any contact point 
can be decomposed into two components [as mentioned in equation(3.7)], 
namely, the particular solution giving the equilibrating force [or manipulation 
force] Fp, and the homogeneous solution giving the grasping force 
Equilibrating force [manipulating force] F^ is determined by the external and 
dynamic forces on the object and can not be specified independently, 
grasping force can be specified independently. 

A stable grasp can be obtained; if there exists a grasping force vector 

F^ such that, for a grasp with F^=F^ and no external force on the object, 
equation(3.27) is satisfied at all contact points by appropriately scalmg t e 
grasping force vector 
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Figure 3.4 : Schematic Representation For a Typical Contact Case 


3.4.1 Optimal Grasping Strategy 

Formulating the optimization problem 

Mn f =(\F'^F^-c^Fln 

Js \ o c ( 3 . 28 ) 

subject to G^F^ = F^ 

where q and are appropriate constants for normalization of the terms 
and Fjn, respectively, in the objective function F^ is the contact force 

vector, n is the unit surface normal vector, G is the Grip Transform Matrix, 
and Fg is the external force applied on the object at the origin of the object 
frame. The term FjF^ is the squared norm of the contact forces. The term 
is the sum of the projection of the contact forces along the corresponding 
contact normals, since it has a negative sign, the minimization of 





maximizes the sum of the projections of the contact forces along the 
corresponding contact normals. The increase of the contact forces due to 
maximization of the sum of the projections of the contact forces along the 
corresponding contact normals is taken care of by the minimization of the 
squared norm of the contact forces. 

Writing the augmented cost function of the equation(3.28), we have 

Aus = c^FjF, - c,F!n + X" (G"F, - FJ (3 .29) 

where is the augmented cost function and X is the Lagrange multiplier. 
From the necessary conditions of optimality 

= 0 and^ =0 (3.30) 

we have 

r = iG‘'F+P« (3.31) 

c 2 

where is the Moore-Penrose inverse [Rao, 1971] of G^, I is the identity 

matrix, and P = -^c,"’c2(/-G*^ G^). 

As we have 

iV = G''iV, (3-32) 

it can be written from equations (3.31) and (3.32) as 

F* = F^ + Ph (3.33) 

The closed form optimal solution for F, gives the optimized value of the 
grasping force F^, since F^ is fully dependent upon external forces. 


dF, 



3.4.2 Grasping Force Considerations 


The grasping force controller as given in equation(3.16) requires the 
specification of the desired force parameter vector . Since and 

^ desired optimal force parameter vector can be obtained from 


N^Lzl,=Pn 


or, z^^L-\NlN^rNlPn 


(3.34) 


when some external force is present, i.e., F^^O. 

Define a scaling law for the grasping force parameter as 


^5d ~ (!■*■%)%£ 
^5d ~ ^7^5d 


(3.35) 


where (^6,^7) are the states of a second order dynamical system [Dasgupta, 
1998] which result in a smooth scaling of z^ and z^. 


In nutshell, using equation(3.33), optimal grasping force vector F^ is 
scaled such as to stabilize the grasp. 


A norm function a can be defined such as to measure the distance of 
any grasp from the good grasp. 

j 

For contact point, the cosine of the friction angle (c.f.a.) a’ can be | 
defined as 



I 

(3.36) 


where w’ is the 2x7 unit normal vector on object surface and 7^' is the contact 
force at the contact point. The numerical value of a* can be changed by 
changing F^ (as changing 7^ changes F^). The optimal c.f.a. vector 





a -[ot’ a? is the c.f.a. vector [Chung, 1993] at all the contact points 

for F^ = Ff^ Fp = 0). Since c.f.a. a* corresponds to a stable grasp, any 

a > a will definitely yield a stable grasp. 



Chapter 4 
Design Details 


4.1 Introduction 

Design is a multistep process which begins with a description of the 
range of tasks to be performed. Several viable alternative configurations are 
then determined, followed by an evaluation of the configurations with 
reference to the sizing of components and dynamic system performance based 
on appropriate technical and economic criteria, a configuration is then 
selected. If no configuration meets the criteria, the process may be repeated 
in an iterative manner until a configuration is selected [Nof, 1985]. 

In the present chapter design scheme and dimensions are given for 
finger links and base plate. Criteria for selection of motor/power drive is also 
discussed. Strain gauges are used to measure the force applied at the fingertip 
and the scheme for the circuitry involved is discussed. 
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4.2 Finger Design 


The planar hand consists of three fingers. Each finger has two links 
with revolute joints and thus each finger has two degrees of freedom. Joint 
axes are all parallel and thus the fingertips can move in a single plane as 
shown in Fig (4.1). 



Figure 4.1 : Planar Hand Joint Axes Schematic. 

The planar hand [Mcdonald, 1986] is having total six degrees of 
freedom. The grasped object [Crossley, 1977] is taken to be having three 
degrees of freedom in the task space namely, one rotational degree of 
freedom in the plane perpendicular to the joint axes and two translational 
degrees of freedom in the plane perpendicular to the joint axes. If we take 
joint axes parallel to the z-axis of the World Coordinate Frame, the 
translational motion will be in the x-y plane of the World Goordinate Frame. 
Thus the position and orientation of the object in World Coordinate Frame 
can be defined by position vectors Po,,Po, the orientation vector as 

presented in the equation (2.25) and as shown in Fig. (4.2). 






Figure 4.2 : Object Position and Orientation Schematic. 


Material Selection : 

. The material for the links is selected on the basis of stiffness- 
tO“Weight ratio [Rivin, 1988], high strength and low weight. To increase the 
stiffness-to-weight ratio, the increase in the elastic modulus E is very 
desirable, if it is not accompanied by an unacceptable increase in specific 
density p. Parameters of some high modulus and/or low specific density 
materials are discussed in [Rivin, 1988]. Best properties are demonstrated by 
ceramics(boron carbide and aluminium) and beryllium. While ceramics are 
brittle and difficult to machine, beryllium is very costly. Fiber reinforced 
materials also have good stiffness-to-weight^ ratio but their applications are 
limited because of creep under constant load (for some compositions), aging,- 
high thermal expansion coefficient, difficulty of joining with metal parts and 
high cost. Popular light structural materials as magnesium, aluminium and 
titanium have the same ^ ratios as that of steel[Andeen, 1988]. Thus these 

materials are used where low weight with high strength is more important 

than ratios. 

/P 

Thus considering all these factors aluminium is selected as material 
for the links. 





Basic Link Featu res : 

The link dimensions are taken so as to minimize the link weight, 
deflection under loading and to maximize the force generated at the end of 
the link. The scheme for finger links arrangement is shown in figure (4.3). 


! f HOTOft 5H/1FT 

R MOTOB shaft 



Figure 4.3 : Finger Links Arrangement Schematic. 

The big end of link-1 is slotted such as to provide ease in assembly. 
With this arrangement the motor can be fixed to link-l end and then link-2 
can be connected lo its shaft or vice-versa as shown in Figure (4.4). 



Figure 4.4 : Link Assembly Schematic. 




The small end of link-1 and big end of Iink-2 is slitted and a screw 
hole is provided as shown in Fig.(4.5). This provision offers a means to 
clamp the shaft and provide ease in assembly and disassembly. 



Figure 4.5 : Provision for Clamping of Shaft. 

The . small end. in link-2 is kept pointed. The cross-sectional 
dimensions of link-2 are reduced so that when some force is applied at the 
fingertip there is a measurable deflection in that part. Strain gauges are 
mounted on the narrow part of the link to measure the deflection. The 
schematic is shown in Fig(4. 6). 



Figure 4.6 : Strain gauge Mounting Schematic. 



(4.8), 


The detailed dimensions for both links are given in Figs. (4. 7) and 



Figure 4.7 : Link-1 Dimensions. 
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Figure, 4.8 ; Link-2 Dimensions. 

Fingertip covering : 

Fingertip covering is made of light rubber in order to increase the 
friction between the fingertip and the object at the contact point. Fingertip 
schematic is shown in Fig.(4.9), 
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Figure 4,9 : Fingertip Covering Schematic. 


Finger Mounting : 

The finger mounting is provided to fix the finger on the base plate. It 
is fastened by a screw on the plate. Aluminium is taken as the material. 

The overall arrangement for the setup is shown in the Fig.(4.10). 
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Figure 4.10 : Overall Finger Arrangement. 


Base Plate : 

Base Plate is provided to mount the fingers. Cast iron is taken as base 
plate material due to its low cost. Four screws are provided to adjust the level 
of the base plate. Slots are provided in the base plate, as shown in 
Fig. (4. 11), to adjust the relative position of the finger bases. In the design of 
the base plate, size and arrangement of the links are taken into account . The 
ease, of arbitrarily changing the position and orientation of the fingertips is 
taken into account . As shown in [Yoshikawa, 1990], the best configuration 
in terms of manipulability is achieved when the angle between the link-1 and 
link-2 is approximately 90 degrees. 
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Figure 4.11 : Base Plate Dimensions. 


Object: 

The object is made of perspex sheet. It is of cylindrical shape and 
made hollow to reduce the weight. Dimensions of the object are shown in 

Fig.(4 12). I ■ 
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Figure 4.12 : Object Dimensions. 
The top view of the actual setup is shown in Fig.(4.13). 



4.3 Motor Selection and Specifications 

The motors required to move the fingers of the planar hand must be 
having high torque-to-weight ratio[Asada, 1987], Also the motors should not 
be very costly. DC servo motor with encoder facility is a suitable choice. The 
DC motor used is having an ironless rotor combined with a commutation 
system containing a graphite copper combination for the brushgear. The 
active rotor part simply consists of cylindrical skew winding and requires no 
support. Because of the absence of an iron core rotor inertia is very low. This 
very low value of inertia allows for increased rates of acceleration and 
deceleration and also provides optimum performance under conditions of 
shock and vibration. The basic features of the motor are given in Table 4,1. 


Features 

Benefits 

Capability of comniutating high 
current densities 

High peak torques with no risk of 
demagnetizing the stator. Very long 
life. 

155 degree Celsius rated motor 
temperature 

Exceptionally high continuous 

torque for the motor size. Savings in 
weight, space, and cooling 

equipment. 

Commutation system of compact 
construction 

Excellent resistance to Revere 
conditions of shock and vibration. 

High torque-to-inertia ratio 

High acceleration, short mechanical 
time constant. 

Robust graphite-copper 

commutation system > 

High peak currents for fast 
incremental motion. Very long life 
in drive and servo systems. 

Low rotor inertia 

High acceleration, excellent 

resistance to shocks and vibration. 


Table : 4.1 Basic Features of the Motor Used. 
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There are no preferred rotor position at stall condition because of 
absence of iron. The rotor is able to stop in any position due to low rotor 
inertia. Motor running speed is not limited by iron losses but depends only on 
supply voltage and load torque. Motor stator part consists of a cylindrical 
two-pole permanent magnet that fits inside a steel tube closing the magnet 
circuit. The selected motor is of very low inductance and they need a 
relatively low current I for a given torque. Arcing during commutation which 
is approximately proportional to PL is therefore much smaller than with 
conventional DC motors. The powerful magnet surrounded by the winding 
generates a strong induction in the air gap. Together with an optimum copper 
volume, power output for a given motor size and weight is exceptionally 
high. The motor specifications are given in Table (4.2). 


Make 

escap® 35NT2R82-426SP 

No. of motors used 

6 

Measuring voltage 

32 V 

No-load speed 

6100 rpm 

Stall torque 

720 mNm 

Average no-load current 

80 mA 

Maximum, continuous current 

2.3 A 

Maximum recommended speed 

9000 rpm 

Maximum angular acceleration 

64x10^ rad! s&P 

Maximum continuous output power 

75 W 

Back-EMF constant 

5.2V/100rpm 

Rotor inductance ' 

0.4 mH 

Motor regulation ^2 ’ ' 

0.89 X 10^ / iVm 

Thermal resistance 

2.2 ohm 


Torque constant 49.7 mNm/A 

Rotor inertia ’ 71.4 x 10 ^ kg nP 

Mass of the motor 310 gms. 

Mechanical time constant r 5.2 ms 


Thermal time constant rotor 60 sec 


stator 920 sec 
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Thermal resistance rotor-body 

3.5 deg.C/W 

body-ambient 

8 deg.C/W 

Axial play 

negligible 

Radial play 

negligible 

Shaft runout 

o 

VI 

Maximum side load at 10 mm from 

35 N 

mounting face ball bearing 


Maximum permissible coil 

155 deg.C 

temperature 


Maximum axial static force for 


press-fit 

100 N 

shaft-supported 

1000 N 

Recommended ambient temperature 

-10 deg.C to +80 deg.C 

range 



♦Graphite brushes and copper commutator with 13 segments 
♦♦Motor is fitted with two preloaded ball bearings. 


Table 4.2 ; Important Motor Specifications. 

Speed Torque diagram for the selected motor is shown in the Fig.(4. 14). 

■ " . — ~ ' . ■ i 

In (rpm) 



ioT 200 300 400 500 


\//a Continuous working range 
“Hgure 4.14 r^tor Operating Range. 
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The speed torque diagram indicates the maximum recommended 
values of speed, torque and power for both continuous and intermittent 
operation. The motor dimensions are shown in Fig. (4. 15) 



4.4 Force Sensing using Strain Gauges 


P-type semiconductor strain gauges [Hahm, 1988] are used to measure 
the deflection in the finger due to force applied at the fingertip. The contact 
force is resolved into two components as shown in Fig.(4.16). One 
component (i^)^ is taken along the link and other component (Fjy is taken 

normal to the link. Wheatstone half bridge [Klafter, 1989] is used as shown 
in Figs. (4. 17) and (4.18). To measure force (i^)^ the Wheatstone bridge 
arrangement as shown in Fig. (4. 17) is used. The force produces bending 
stress in the finger, whereas the force (fJ^ produces compressive stress on 
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the finger link. The arrangement for measurement of the force (-^)„ is shown 
in Fig.(4.18). 



Figure 4.16 : Resolving the Components of the Contact Force F^. 



Figure 4.17 : Wheatstone Bridge Arrangement for measurement of (/•),. 



Figure 4.18 : Wheatstone Bridge Arrangement for measurement of (i^) . 


The half bridge is balanced when there is no load on the finger tip. 
Potentiometer resistance is used to adjust the bridge output to zero when 
gauges are not strained. The values of balancing potentiometer and resistor 
in parallel are chosen so that the output voltage may be raised or lowered, 
since the initial imbalance could have either polarity. A single potentiometer 
could also be used instead of parallel combination but the resolution will be 
very poor and fine adjustments to balance the bridge for no-load conditions 
will be very difficult. 

As soon as the tip touches and starts pushing the object the finger 
deflection changes the strain gauge resistance which unbalances the bridge. 
The output voltage is amplified using a PCLD-789 amplifier/multiplexer 
board. The PCLD-789 is connected to PC and a software reads the amplified 
output voltage values. The Printed Circuit Board (PCB) diagram for half 
bridge for measuring transverse force is shown in Fig. (4. 19). 
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Complete schematic for the force feed back is shown in Fig.(4.20). 



Figure . Force Feedback Schematic. 


The specifications for the selected strain gages are given in Table 4.3. 


Type 

p-type semiconductor strain gage 

Lot tolerance resistance 

300 + 10 % ohm 

Gage factor 

100 

Effective gage length 

< 5 mm 

Effective gage width 

<0.25 mm 

Effective gage thickness 

0.025 mm 

Overall size 

8 mm X 6 mm 

Base material 

Phenolic encapulation 


Table 4.3 : Strain Gauge Specifications. 
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Chapter 5 

Implementation, Results and 
Discussions 


5.1 Strain Gauge Calibration 

Strain gauges form part of the Wheatstone bridge circuit which is kept 
balanced for no-load-at-fmgertip condition by adjusting the potentiometer 
resistance value. When some external force is applied at the fingertip, the 
finger is deflected and thus the resistance of the strain gauges changes. This 
change in the resistance causes unbalances in the Wheatstone bridge. Thus 
the output voltage changes from zero to some finite value. We can apply 
some known force at the fingertip and then the output voltage value could be 
read. Thus the chart for the force and the corresponding output voltage value 
can be prepared. The same chart can be used to read the force value if the 
output voltage value is known. Thus the fingertip is calibrated for the force 
applied and corresponding output voltage. 

The calibration chart for the transverse load only, is as shown in Table 


( 5 . 1 ). 



Mass 

Output 

Mass 

Output 

Mass 

Output 

attached at 

voltage 

attached at 

voltage 

attached at 

voltage 

fingertip 

shown on 

fingertip 

shown on 

fingertip 

shown on 

(gms) 

the screen 

(gms) 

the screen 

(gms) 

the screen 

10 

1 

110 

9 

210 

18 

20 

2 

120 

10 



220 

19 

30 

3 

130 

12 

230 

19 

40 

4 

140 

12 

240 

20 

50 

5 

150 

13 

250 

20 

60 

5 

160 

13 



70 

6 

170 

14 



80 

7 

180 

15 



90 

8 

190 

16 



o 

o 

8 

200 

17 




Table 5.1 : Calibration Chart for Strain Gauges. 
(Qnly for the transverse load.) 


The chart is same for all three fingers as the gage factor and the other 
properties for all strain gages are same. We can also show the results of the 

calibration in a graph as shown 'n ’gC ) 

a'trifccT A 






















(Xilput Voltof e 
SiQwn on the Termmcil 





Figure 5.1 : Graphical Representation of Calibration Results 


5.2 Amplification of Bridge Output 

Strain gauges are connected to the Wheatstone half bridge PCB to 
complete the bridge. The complete bridge circuit is as shown in Fig.(5.2). 
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PCLP-789 (Amplification / Multiplier Board) : 

Analog to digital conversion of the differential voltage of the 
Wheatstone bridge is carried out inside the PC- AT 386 using PCL-208 card, 
which is a standard PCB series data acquisition card. However, it requires 
voltage signals in a particular range to be applied to the input channels of the 
ADC cards. The dil terential voltage from the bridge is of very small value, 
thus the signal needs to amplified before it can be fed to the input channel 
of the PCL-208 ADC card. Amplification of the differential input signal is 
done through the PCLD-789 card, which has instrumentation amplifiers with 
a range of gain selection. We take the gain of 1000. The amplification is 
noise free. 

The PCLD-789 has 16 differential inputs, out of which first three are 
used to read the output of three pairs of strain gauges for three fingers. The 
channel selection is done through the PCL-208 card, which is used for 
interfacing. All software requirements are dictated by the PCL-208 ADC 
card. PCLD-789 does not take part in any other software manipulations 
except for multiplexing the desired channels and connecting the selected 
input to the output. 

PCL-208 (Data Acquisition Card) : 

The PCL-208 card is used for analog to digital conversion (ADC) and 
data acquisition. The card supports 16 single ended or 8 differential analog 
input configurations. As the PCLD-789 card output is a single ended signal, 
we use the ±5 F single ended input range. This is switch selectable, -using 
different jumper settings. More details could be seen from the Owners 
Manual PCL-208. 

PCL-208 uses 12 bit A/D conversions and an 8 bit register is not 
enough to accommodate all 12 bits of data. Therefore A/D data is stored in 
two registers located at address BASE +0 and BASE +1. Through software 
we can easily convertit to a single number to refer to a particular voltage 

output. 

Software Part : 

PC- AT 386 uses vectored interrupts. Whenever a device interrupts the 
processor, it is responsible for telling the CPU which interrupt service 
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routine should be executed. The software for interacting and control make 
use of the vectored interrupts. In order to obtain a real time signal, the timer 
tick interrupts of PC-AT 386 is used. The timer tick interrupt at vector 1C 
Hex comes 18.2 times per second. This is because the standard bus clock 
signal of 2.38 MHz is first divided by 2 and then by (2'®-l), as the divisor 

latch (internal to the clock) is loaded by (2’®-l). Since this rate of timer tick 

interrupt is too small, the divisor latch is loaded by the software with decimal 
256 to obtain exactly 4648 real time interrupts per second. All events, 
sampling, delays etc., are subsequently timed by this clock. 

Force feed back is through the strain gauges mounted at the base of 
the finger links. The complete A/D operation for reading the differential 
voltage of the strain gauges can be divided into many steps. Initially input 
channel is set by specifying the scan range. Then trigger by writing to the 
A/D low byte register (BASE +0) with any value wait for the end of 
conversion by reading the A/D status register (BASE +8). Now data from 
A/D converter is read, by reading the A/D data registers. The binary digital 
data is converted to integer value, which is shown on the screen. 

5.3 The Controller Board 

A controller board is designed for real time control of all six motors 
through the printer port of the PC-AT 386. One board is designed to pontrol 
four motors, so two such boards are used to control simultaneously all the six 

motors. , 

The basic scheme for control involves the principle of pulse width 

modulation. An asymmetric square wave is generated through the software. 

The duty cycle of the pulse wave form determines the relationship between 

the input and output voltage. Duty cycle is the ratio of ON time to the period 

of the pulse wave form. The motor is switched ON for a time t„ and then 

switched OFF for a time This cycle is repeated. Thus the motor speed 

and torque can be varied by varying ON and/or OFF time intervals. Thus 

effectively the pulse width is used to change the motor torque as shown ,n 

Fig.(5.3),, . .. 
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Figure 5.3 : Pulse width Modulation with Square Wave form. 


In the meantime when one motor is kept OFF, other five motors are 
one by one switched ON and OFF to provide torque at all finger joints. The 
frequency of pulse is very high and when the motor is kept OFF, the object 
does not fall. The combined wave form for all six motors is shown in 
Fig.(5.4). - 
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The controlier board exchanges data from the printer port of PC-AT 
386 and supplies power to all six motors in small pulses. 26-pin FRC from 
the printer is connected to controller board, where the signals go to L-298 
dual full-bridge driver chip, whose block diagram is shown in Fig.(5.5). 



Figure 5.5 : Block diagram for L-298 Dual Full Bridge driver. 

! 

L-298 driver allows power to be supplied to the specified motor for 
the specified time duration as per the instructions from the software coming 
through printer port of PC-AT 386. For controller board- 1 which controls 4 : 

motors, the signal is sent through address 278 Hex. The 8-bit signal allows 2 
bits each for all four motors to be run through board- 1. A binary 01 moves 
the motor in forward direction, while binary 10 cause it to move in reverse 
direction. Binary 00 or 11 causes it to stop. Least significant bit denotes 
forward motion, while most, significant bit represents the reverse motion of 
the motor. Table (5.2) contains the signal values required for various motion 
combinations. 
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Allocation 

Output 

Hex 

Motor 

Motor 

Motor 

Motor 

B2 

Bl 


A2 


A1 


.Signal 

from 

Motion 

Motion 

Motion 

Motion 

0 0 

0 

0 

0 

0 

0 

0 

208 

0x00 

S 

s 

S 

S 

0 0 

0 

0 

0 

0 

0 

1 

, 208 

0x01 

F 

s 

S 

s 

O 

O 
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0 

0 

0 
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0 

208 

0x02 

R 

s 

s 

s 

0 0 

0 

0 

0 

1 

0 

0 

208 

0x04 

S 

F 

s 


0 0 

0 

0 

1 

0 

0 

0 

208 

0x08 

s 

R 

s 

s 

0 0 

0 

1 

0 

0 

0 

0 

208 

0x10' 

s 

S 

F 


0 0 

1 

0 

0 

0 

0 

,0 

208 

0x20 

s 

s 

R 


0 1 

0 

0 

0 

0 

0 

0 

208 

0x40 

s 

s 

s 

F 

1 0 

0 

0 

0 

0 

0 

0 

208 

0x80 

s 

s 

s 

R 


Table 5.2 : Signals for Different Motor Motions. 


Using the logic in bit allocation for motors, various other 
combinations for simultaneous motions of two or more motors could be 
possible. ' 

Similarly for controller board-2, which controls motors Cl and C2. the 
signal address is. 27a Hex. Same logic is applied in bit allocation for motors 
Cl and C2 as presented, above for board-1 except that the address changes to 

27a Hex, instead of 278 Hex. 

The PCB diagram fof controller board is shown in Fig. (5. 6). 








































PCB diagram for the controller board 
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PCB diagram for the feedback board 
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5.4 Feedback Board 

The feedback board was planned to take the position feedback from 
the encoders and send it to PCL-812 enhanced multifunction card with AD- 
DA/DIO/TC facility. As motor shaft moves, the encoder keeps track of the 
rotation with respect to some reference point. This position status from the 
incremental encoder goes to feedback board, where information regarding 
direction of motion of the motor shaft is extracted from it. The encoder pulse 
increment or decrement is recorded and counted. The desired position of the 
motor is read from the PCL-812 card and the actual position of the status is 
sent to PCL-812 card. Unless the required position is reached the motor is 
moved in suitable direction. The PCB diagram for feedback board is shown 
in Fig. (5.7). This board could not be fabricated due to unavoidable 
circumstances. 

Fig.(5.8) shows the nomenclature convention followed for naming the 
motors mounted on different fingers. 



Fig 5.8 : Nomenclatore fcbnvention for Motors and Fingers. 




Di 


5.5 Results and Discussions 

In the absence of feedback board, the position feedback could not be 
used and the closed-loop control scheme could not be applied. Therefore the 
objective was simplified to a stationary grasp of the object so that the fingers 
provide enough force to hold the object under gravity loading. This objective 
was achieved by open loop control of motor current. The current to motor 
was gradually increased till the object could be held without any slip. With 
the object held stationary, an attempt was made to correlate the motor current 
with the strain gauge reading. 

The motors are controlled using the controller boards according 
to the principal of pulse modulation. The current passing through the motors 
is measured by measuring the voltage across a known resistance put in series 
with the motor. The current is varied by varying the proportion of positive 
pulse in one time period. Using the motor torque-constant data, the torque 
applied at each motor could be determined. This torque is converted to the 
force applied at the fingertips. This force is matched with the strain gauge 
feedback using the calibration chart. The nomenclature convention for 
motors followed is shown in Fig (5.8). 

The observations for the strain gauges circuit output voltages for three 
fingers at the time of grasp are shown in Table(5.3). These observations are 
taken for transverse force on the fingertip. 


Finger 

Reading Shown on PG 
Terminal Screen (volts) 

A 

-2.5 

B 

-2.3 

C 

-1.4 / 


Table 5.3 : Output Voltage Observations. 
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Using calibration chart as shown in the Fig.(5.1), we convert the 
Wheatstone bridge output voltage to force applied at the fingertip. The 
converted values for the transverse force are shown in the Table (5,4). 


Finger 

Bridge output voltage 
(value from the screen) 
(volts) 

Transverse Force at the 
fingertip 

(N) 

A 

-2.5 

0.2888 

B 

-2.3 

0.2657 

C 

-1.4 

0.1617 


Table 5.4 : Conversion Chart. 

The total cycle time and positive cycle time for each motor are 
recorded using portable digital oscilloscope. The rms voltage values across a 
known resistor of 5.3 ohm resistance value are also recorded for each motor. 
The observations are shown in the Table (5.5). 


Motor 

rms Voltage 

(Volts) 

Positive Pulse 

width 

(m^) 

Total Period 
(ms) 

Frequency 

(Hz) 

A 1 

1.46 

214 

2.48 

403 

A2 

2.20 

464 

2.48 

403 

B1 

1.18 

174 

2.48 

403 

B2 

2.28 

450 

2.48 

403 

Cl 

1.14 

, 150 

2.48 

403 

C2 

2.12 

390 

2.48 

403 


Table 5.5 : Peak Voltage Observation. 

The rms current value wii^ the 5.3 ohm resistance is calculated and 
shown in Table (5.6). 
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Motor 

rms Voltage 

Kn^ ^oltS 

Resistance 

R ohms 

rms Current 

Torque 

49.7xlO-V_ Nm 

A1 

1.46 

5.3 

0.2755 

0.0317 

A2 

2.28 

5.3 

0.4302 

0.0214 

B1 

1.18 

5.3 

0.2226 

0.0111 

B2 

2.28 

5.3 

0.4302 

0.0214 

Cl 

1.14 

5.3 

0.2151 

0.0107 

C2 

2.12 

5.3 

0.4000 

0.0199 


Table 5.6 : Current and Torque Calculations. 


Motor torque constant is 49.7mNm/A [Table 4.2], thus motor torque is 
calculated by multiplying motor torque constant with the rms current value. 

The angles between the links are measured using the photographs 
taken for each link and the finger Jacobian matrix is calculated as shown 

in equations(2.9) and (2.10). 

The values for measured angles in degrees are shown in Table (5.7). 


ej 

e‘ 

ef 


e? 


197 

126 

7 

95 

102 

86 


Table 5.7 : Measured Joint Angles 


Here 0|,02 (i»l,2,3) are the joint angles for link-1 and link-2, respectively, 
for the i'^ finger Length for link-1 and link-2 is taken as 7.5 cm and 8 cm 
respectively. 

The finger Jacobian matrix is calculated as 



0.07007 

-0.00783 

0 

0 

0 

0 


0.04815 

0.06389 

0 

0 

0 

0 


0 

0 ’ 

-0.08739 

0.05781 

0 

0 


0 

0 

-0.07825 

-0.01663 

0 

0 


0 

0 

0 

0 

-0.06223 

-0.09482 


0 

0 

0 

0 

0.01113 

-0.07922 


(5.1) 
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The inverted Jacobian matrix is computed as 


13.1616 

-9.92239 

0 

0 

0 

0 


1.6142 

14.4443 

0 

0 

0 

0 


0 

0 

-2.7827 

13.0918 

0 

0 


0 

0 

-9.6714 

-14.6209 

0 

0 


0 

0 

0 

0 

-13.2358 

-1.8692 


0 

0 

0 

0 

15.8412 

-10.3965 


(5.2) 


The position vector of contact points on object surface is as following 


-0.069 

0.011 

0.034 

-0.023 

0.053 

0.046 


(5.3) 


From equation(2.35) we have x = JjF,. Thus we can write as 



The torque vector can be written from Table(5.6) as 


t = 


0.0137' 
0 0214 
0.0111 
0.0214 
0.0107 
0.0199 


(5.5) 


Calculating the contact force vector F^, we have 



0.2149 

0.1730 

-0.2379 

-0.1676 

0.1736 

-0.2268 


(5.6) 
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The Grip Transform matrix G is calculated [equations(2.31)-(2.32)] as 


G = 


1 

0 

1 

0 

1 

0 


0 - 0.011 
1 -0.069 

0 0.023 

1 0.034 

0 -0.046 

1 0.053 


(5.7) 


From equations(2.37)-(2.38) the force is calculated as 



0.1506 

-0.2214 

-0.0454 


(5.8) 


Thus the net resultant force on the object at the centre of object frame 
is 0.2677 N and net resultant torque about z-axis of the object frame is 
-0.0454Nm. 


It is to be noted that the calculation(5.8) shows a net resultant 
force/torque on the object. However, in the actual experiment, the object was 
observed to be completely stationary for nearly 45 minutes. In order to 
resolve this discrepancy, some numerical trials were taken by varying the 
joint angle vector and the joint torque vector. It was observed that is not 
very sensitive to small variations in the joint angle vector. Whereas F^, and 
thus was found to change significantly with small changes in the joint 


torque vector t . For example, with an assumed x vector as 


0.0107 

0.0227 

0.0173 

0.0210 

0.0105 

0.0129 


which is 


close to the one in equation(5.5), was calculated to be 



0.1775 

0.2216 

-0.2512 

-0.0806 

0.0654 

-0.1536 


(5.9) 
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and was computed as' 



-0.0084 

0.0126 

-0.0368 


(5.10) 


Here the net resultant force reduces from 0.2677N [see(5.8)] to 
0.0151N[see(5.10)]. 

In fact, t was calculated by reading the rms value of voltage across 
the resistance (as shown in Table(5.6)). The pulse width modulation to 
control the motor current is shown in Fig(5.4). Since there is no way to 
measure the actual current to the motor, the torque calculations were based 
on rms values. This procedure is obviously not accurate. The transverse 
component values as shown in Figs. (4. 6) and (4.16) for the three-fingers 

are shown in Table(5.8). 


Finger 

Transverse force 

component from 

equation(5.6). 

Transverse force 
component from 
strain gauge 

readings. 

[Table(5.3)-(5.4)] 

Transverse force 

component 
[equation(5.9)] for 
the assumed torque 
vector close to the 
original one given 
in eqn.(5.5) 

A ^ 

0.2675 

0.2888 

0.2838 

B 

0.2625 

0.2657 

0.2625 

C 

0.2488 

0.1657 

0.1612 


Table 5.8 : Transverse components for the three-fingers 


From Table(5.8) it is clear that the strain gauge readings for transverse 
force for the three-fingers match with the values in the last column of 
Table(5.8). The values in the last column of Table(5.8) give net resultant 
force on the origin of the object frame very near to zero which means that the 
grasp was stable for the static case. In actual experiment also, the object was 




observed to be completely stationary. Thus the values of the transverse force 
for the three-fmgers in columns three and four of Table(5.8) are in 
accordance with each other. The values in the second column does not match 
with the strain gauge output, since there is no way to measure the actual 
current to the motor. 

In the full real time implementatation with closed-loop control, there 
is no need to measure the current. The current will be controlled directly 
through the feed back loop. 
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